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On 

^ (57) Abstract: The robot comprises: - a controller (C), including power modules (22) for supplying the motors (10) of the arm (A) 
of the robot (R), a CPU unit (26), for calculation and processing and connection means (52, B), between the arm (A), the power 

^ modules (22) and the CPU unit (26). The connection means (52, B) comprise a single functional bus (B) which connects a control 
unit (30), associated with the CPU unit (26), firsdy to the power modules (22) and, also, to the digital interfaces (14) with the sensors 

O (12) on the arms (A). Said interfaces (14) are either integrated with the arm (A) or located in the immediate vicinity thereof. 
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En ce qui concerne les codes a deux lettres et autres abrivia- 
tions, se riferer awe "Notes explicatives relatives aux codes et 
abriviations" figurant au debut de chaque numiro ordinaire de 
la Gazette du PCX 



(57) Abrege : Ce robot comprend : - un contrdleur (C) qui inclut des modules de puissance (22) permettant ralimentation en courant 
de moteurs (10) du bras (A) du robot (R) et une unit6 CPU (26) de calcul et de traitement - des moyens de liaison (52, B) entre le 
bras (A), les modules de puissance (22) et l*unit6 CPU (26). Les moyens de liaison (52, B) comprennent un bus fonctionnel unique 
(B) qui relie une unite de controle (30), associee a l'unit6 CPU (26), d'une part, aux modules de puissance (22) et, d'autre part, a des 
interfaces (14) numenques avec des capteurs (12) embarquSs sur le bras (A), ces interfaces (14) 6tant integrees au bras (A) ou situees 
dans son voisinage immecliat. 
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ROBOT MULTI-AXES EQUIPE D'UN SYSTEME DE COMMANDE 

L' invention a trait a un robot multi-axes equips d'un 
5 systeme de commande. 

II est connu que les robots mult i -axes peuvent §tre 
commandes en • fournissant a leurs moteurs electriques des 
signaux de commande generes a partir d'une unite de calcul 
et de traitement dans laquelle est determinee la 

10 trajectoire du robot. Pour que le calcul de trajectoire 
soit efficace, il est connu, par exemple de US-A-4, 786, 847 
de faire travailler 1' unite precitee en boucle fermee, en 
utilisant des signaux de contre- react ion provenant de 
capteurs de position portes par le bras du robot.. Dans les 

15 robots connus, un grand nombre de cables doivent §tre 
installes entre le bras et son unite de commande, ce qui 
induit des temps de connexion et de cablage important s et 
des risques d'erreur non negligeables induisant des 
operations de deboguage complexes et coQteuses . 

20 II est connu de EP-A-0 777 167 d'utiliser un bus en 

fibres optiques pour connecter un controleur numerique a 
des amplificateurs relies chacun a un codeur par une ligne 
classique. Ces liaisons entre les amplificateurs et les 
codeurs rend longue et complexe 1 ' installation de ces 

25 materiels. 

Par ailleurs, JP-A-10 178 437 prevoit de relier par un 
bus des codeurs a un ordinateur externe et ce, 
independamment de la partie de puissance de 1' installation. 
C'est a ces inconvenients qu'entend plus 

30 particulierement remedier 1' invention en proposant une 
nouvelle architecture pour un robot equipe d'un systeme de 
commande qui simplifie la fabrication du contrdleur, d'une 
part, et du bras, d' autre part, et 1' installation de ce 
robot sur son site d' utilisation. L' invention vise 
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egalement a ameliorer la qualite et la Vitesse de transfert 
des signaux de contr61e et de contre-reaction. 

Dans cet esprit, 1' invention concerne tin robot multi- 
axes comportant un bras apte a deplacer un outil dans 
5 I'espace et actional par des moteurs electriques, ainsi 
qu'un systdme de commande comprenant : 

- un "controleur qui inclut au mo ins un module de 
puissance permettant 1 ' alimentation en courant des moteurs 
et au moins une unite de calcul et de traitement 

10 permettant, notamment, le calcul de trajectoire du bras et 
la generation de signaux de contr61e du ou des modules 
pr^cites ; 

- des moyens de liaison entre le bras , le ou les 
modules de puissance et 1' unite precitee, ces moyens de 

15 liaison permettant au moins 1' alimentation des moteurs a 
partir du ou des modules de puissance et le controle de ce 
ou ces modules par 1' unite de calcul et de traitement, 
ainsi que la transmission de signaux de contre- reaction du 
bras vers cette unite et/ou ce.ou ces modules. 

2 0 Ce systeme est caracterise en ce que les moyens de 

liaison precit^s comprennent un bus fonctionnel unique qui 
relie une unite de controle associee & 1' unite de calcul et 
de traitement, d'une part, au(x) module (s) de puissance et, 
d' autre part, a au moins une interface numerique avec au 

25 moins un capteur de position embarqug sur le bras, cette 
interface etant int^gree au bras ou situee dans son 
voisinage immediat. 

Grace a 1' invention, les informations de contre- 
reaction relatives §l la position et & la vitesse des 

30 elements mobiles du robot ainsi qu'au courant consomme par 
les differents moteurs sont disponibles pour 1' unite de 
calcul et de traitement a la frequence du bus. En outre, 
les signaux numSriques transitant dans le bus sous forme 
numerique sont peu perturbes par le bruit ambiant, a la 
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difference de signaux analogiques. Une optimisation du 
controle de trajectoire est obtenue par le traitement 
centralise des boucles d'asservissement. L' utilisation de 
la ou des interface (s) permet de mettre en serie ou 
5 « serialiser » des informations provenant de capteurs 
numeriques ou de num£riser et de serialiser des 
informations provenant de capteurs analogiques, puis de les 
faire transiter vers le bus serie. L' invention permet de 
conserver les avantages d'un systeme centralisant 

10 fonctionnellement la generation de trajectoire et les 
asservissements . La ou les interface (s) permet (tent) 
egalement de calculer, au plus prds des- capteurs ou 
codeurs, les vitesses et/ou accelerations des parties 
mobiles,- & une frequence multiple de celle du bus, ce qui 

15 permet de reduire le retard entre 1 ' information de 
position, de vitesse et/ou d' acceleration, en vue d'un 
meilleur asservissement . Le fait d'utiliser un bus 
fonctionnel minimise le nombre de cables conduct eurs dans 
1' installation, en particulier a l'interieur du bras, d'oti; 

2 0 une meilleure implantation du ou des cables de connexion, 

des contraintes dimensionnelles allegees pour les elements 
du bras, une meilleure accessibility aux elements inclus 
dans ce bras et une facility d'obtention de la mobility de 
ce bras car le rayon de courbure minimum du bus peut etre 
25 relativement faible. Le robot conforme a 1' invention est 
plus economique a concevoir et a fabriquer et peut 
benef icier d' algorithmes qui le rendent plus rapide et plus 
precis que ceux de l'art anterieur. 

Selon \in aspect tout k fait avantageux de 1' invention, 

3 0 le bus fonctionnel unique se decompose en au moins deux bus 

structurels qui relient, pour le premier, l'unit§ de 
contrdle au(x) module (s) de puissance et, pour le second ou 
les deuxi^me et suivants, 1' unite de controle a 1' interface 
ou aux interfaces. Le fait d' avoir au moins deux bus 
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structurels distincts permet d' adapter chacun de ces bus au 
lieu dans lequel il est installe : le premier bus peut §tre 
metallique, notamment en cuivre, alors gu'un autre bus 
peut, par exemple, §tre en fibres optiques, ce type de bus 
5 etant particulierement immunise par rapport aux bruits 
electromagnet iques ambiants et pouvant §tre de grande 
longueur tout* en conservant une grande rapidite. Le fait 
d'utiliser plusieurs bus structurels permet de contourner 
le probldme du aux limites de leur bande passante pour 

10 ajouter, en cas de besoin, plus d' elements ou plus 
d' informations trait^es par 61£ment. 

De fagon avantageuse, 1' unite de controle est reliee a 
1' unite de calcul et de traitement par un bus de type PCI 
(« Peripheral Component Interconnect ») . En variant e, 

15 1' unite de controle est integree a l'unit6 de calcul et de 
traitement . 

Une carte d' identification et de calibration peut §tre' 
embarquee sur le bras ou situee dans son voisinage 
itnmediat, cette carte etant integree au bus. Ceci permet de 
20 t£lecharger aisement vers 1'unitS de calcul et de 
traitement les paramdtres propres au robot . On peut ainsi 
parler de connexion « plug and play » . 

Le ou chaque bus structurel peut §tre apte a etre 
etendu par des moyens de connexion complement aires a au 
25 moins un organe externe, tel qu'un septiSme axe, notamment 
ion axe de convoyeur, ou tout organe trait ant de 
1' information, comme un dispositif de security. 

Les moyens de liaison peuvent comprendre, en outre, un 
conducteur de puissance reliant le ou les modules precites 
30 au robot, independamment du bus fonctionnel. 

Le premier bus structurel est avantageusement raccorde 
directement ou indirectement & des modules de puissance 
dedies chacun a un moteur du robot. On peut, en outre, 
prevoir que 1' interface precit^e est une carte d' interface 
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apte £ calculer la vitesse et/ou 1 ' acceleration du 
mouvement mesure par le ou chaque capteur associg, a 
serialiser son signal de sortie et, eventuellement , a 
num^riser prealablement les signaux de sortie du ou des 
5 capteurs lorsqu'ils sont analogiques. En variante, 
1' interface en question est integree au capteur associe, 
avec les memes 'fonctions que ci-dessus. 

L' invention sera mieux comprise et d'autres avantages 
de celle-ci appara£tront plus clairement a la lumiere de la 

10 description qui va suivre d'un mode de realisation d'un 
robot multi-axes et de son systeme de commande conformes i. 
1' invention, donne uniquement & titre d'exemple et faite en 
reference au dessin annexe dans lequel la figure unique est 
une representation schematique de principe d'un systdme de 

15 commande et d'un robot multi-axes associes. 

Le bras A du robot R repr^sente sur la figure est 
dispose le long d'un trajet de convoyage figure par une 
direction X-X' . Ce bras est pourvu de six moteurs aptes a 
mouvoir chacun une partie mobile du bras autour d'un de ses 

20 six axes pour deplacer un outil O dans l'espace. Ces 
moteurs sont representee par un ensemble de motorisation 10 
sur la figure. En pratique, ils sont repartis a l'interieur 
du bras A. Six capteurs ou codeurs de position analogiques 
12 sont repartis dans le robot R et permettent de mesurer 

25 les deplacements du bras autour de chacun de ses six axes. 

Trois cartes d' interface 14 sont montees sur le bras A 
et sont associees chacune & deux capteurs 12 . Chaque carte 
14 permet de numeriser et de serialiser le signal 
analogique de sortie d'un capteur ou codeur 12. Chaque 

30 carte 14 permet 6galement de calculer la derivee premiere 
et/ou la derivSe seconde du signal ainsi genere, ce qui 
permet de determiner la vitesse et/ou 1 ' acceleration 
correspondante pour la partie mobile concernSe du robot R. 
Comme les cartes 14 sont situ^es §. proximite des capteurs 
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ou codeurs 12, les calculs de derives peuvent §tre 
effectues avec une frequence elevee, de l'ordre de 20 kHz, 
alors que les trames d' information sont transraises i. 10 
kHz. 

5 En pratique, les cartes 14 peuvent etre, selon les 

choix de construction, integrees aux capteurs 12 , communes 
a deux capteurs et reparties dans le bras A, comme 
repr^sente, ou disposees au pied du bras A, Une seule carte 
peut constituer les differentes cartes 14 sus-mentionnees. 

10 Le robot R inclut egalement un controleur C de 

commande du bras A, ce controleur comprenant une enveloppe 
20 dans laquelle sont t loges .six modules de puissance 22 
alimentes en courant par un c&ble 24 . Chaque module 22 est 
dedie a l'un des moteurs du bras A, ces six modules 22 

15 etant relies au bras A par un premier cable de liaison 52, 
§l dix-huit conducteurs. En pratique, les moteurs du sous- 
ensemble 10 sont des moteurs triphases et chaque module 22 
est relie au moteur correspondant par trois conducteurs. 

Une unit£ de calcul et de traitement 26, couramment 

20 denommee « CPU », est egalement disposee dans 1' enveloppe 
20 et est reliee par un bus PCI 2 8 a une carte de controle 
3 0 pouarvue d'une interface 32, 

En variante, la carte 30 peut etre integree a la carte 

26. 

2 5 Un ordinateur portable externe 6 0 peut §tre relie par 

une liaison Ethernet 62 a 1' unite 26 en vue de sa 
progr animation et/ou de la visualisation de ses parametres 
de f one t i onnement . 

L' unite 26 permet de calculer la trajectoire du robot 

30 R et de g^nerer des signaux de commande de chacxin des 
modules 22 qui commandent eux-memes chacun un moteur du 
sous-ensemble 10. Pour commander ces modules 22 en tenant 
compte du comportement reel du bras A, 1' ensemble forme des 
elements 26 a 30 est relie par un bus fonctionnel unique B, 
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d'une part, k trois cartes 34 contr61ant chacune deux 
modules 22 et, d' autre part, aux trois cartes d' interface 
14. 

Le bus B se decompose en deux bus structurels B x et B 2 . 
5 Le bus Bi, realise en cuivre et . contenu dans 

l'enveloppe 20, permet de faire transiter vers les cartes 
34 les signaux' de commande des modules 22 et, par la, de 
contr61er les moteurs du sous-ensemble 10. Des informations 
circulent egalement des cartes 34 vers la carte 30 & 

10 t ravers le bus B x . 

Le second bus structurel B 2 est forme par des fibres 
optiques et comprend un cable 54 de liaison entre 
1' interface 32 et une carte 16 d' identification et de 
calibration montee & proximite du pied du bras A, cette 

■15 carte 16 6tant relive, en serie, par le second bus B 2 a 
chacune des cartes 14 . 

Le fait que le bus B 2 est realise en fibres optiques, 
permet de 1'immuniser contre les perturbations 
electromagnet iques pouvant resulter du fonctionnement des 

20 moteurs du sous-ensemble 10 ou des codeurs 12. 

Pour 1' unite 26, les deux bus structurels Bi et B 2 
f orment un unique bus fonctionnel B avec lequel elle 
interagit, a travers la carte 30, pour emettre ou recevoir 
des signaux de controle. 

25 Compte tenu de 1' utilisation des bus structurels B x et 

B 2 , la transmission d' informations a la carte de controle 30 
est particulierement rapide, en pratique realisee avec une 
periodicite inferieure & 100 micro- secondes . Les 
informations transitent de fagon egalement rapide entre les 

30 elements 26 et 30, ceci a travers le bus PCI 28. 

Comme represent^ en traits pointilles sur la figure, 
le bus structurel B 2 peut §tre ouvert pour int^grer des 
moyens de connexion complementaires B' 2 pour le controle 
d'un axe externe, tel qu'un axe convoyeur, avec un module 
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de puissance 22', deux capteurs 12' et une carte 
d' interface 14'. 

De meme, des moyens de connexion B' x peuvent permettre 
de relier le bus B* §. une carte d' interface 14 associee & 
5 un capteur 12'', par exemple au sein d'un dispositif de 
securite . 

Ainsi, 1' invention confdre au systeme de corranande une 
grande flexibility permettant de 1' adapter a son 
environnement de travail. En particulier, il n'est pas 

10 necessaire d'aj outer des cables & la liaison entre le 
controleur C et le . bras A lorsque le contrdle d'un axe 
externe doit etre ajoute. 

L' installation du robot R et de son systeme de 
commande est particulidrement aisee car les informations 

15 stockees sur la carte 16 permettent d'envisager une 
reconnaissance du robot R par le contr61eur C lors du 
branchement du bus B 2 entre 1' interface 32 et cette carte 
16. 

L' invention permet de diminuer sensiblement les cofits 
20 de conception, de fabrication et de cSblage du systeme de 
commande d'un robot, alors que les informations collecties, 
en particulier en ce qui concerne les positions, vitesses 
et accelerations des parties mobiles du robot, sont 
disponibles aussi rapidement et avec plus de precision que 
25 dans les dispositifs les plus performants a systdme 
structurellement centralise avec bus parallele. 

L' invention a ete representee avec un bus f onctionnel 
forme de deux bus structurels B x et B 2 - Cependant, un seul 
bus ou, au contraire, plus de deux bus structurels peuvent 
30 etre pr£vus. 

L' invention n'est pas limitee aux robots equipes de 
capteurs de position analogiques. Elle peut §tre mise en 
ceuvre avec des capteurs numeriques, auquel cas 1' interface 
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realis^e par les cartes 14 de 1'exemple decrit peut §tre 
integree a chaque capteur. 

La carte d' identification et de calibration 16 peut 
§tre prSvue dans le contr61eur C et non pas au niveau du 
5 bras A, auquel cas les elements A et C sont appari^s car 
c'est la carte 16 qui permet & 1' unite 26 de 
« reconnaitre •»' le bras A. 



WO 2004/079464 




PCT/FR2004/000245 



REVENDICATIONS 

1. Robot multi-axes comportant un bras (A) apte a 
5 deplacer tin outil (0) dans l'espace et actionne par des 

moteurs electriques (10), ainsi qu'un systdme de commande 
comprenant : 

- un controleur (C) qui inclut au raoins un module 
de puissance (22) permettant 1' alimentation en courant 

10 desdits moteurs (10) et au moins une unit£ (26) de calcul 
et de traitement permettant, notamment, le calcul de 
trajectoire du bras (A) et la generation de signaux de 
controle desdits modules, 

- des mbyens de liaison (52, B) entre ledit bras, 
15 ledit module de puissance et ladite unite permettant au 

moins 1 ' alimentation desdits moteurs & partir dudit module, 
ie contr61e dudit module par ladite unitg et la 
transmission de signaux de contre- reaction dudit bras vers 
ladite unite et/ou ledit module de puissance, 

20 caracterise en ce que lesdits moyens de liaison (52, B) 
comprennent un bus fonctionnel unique (B) qui relie une 
unite de controle (30) associee a ladite unite de calcul et 
de traitement (26) , d'une part, audit module (22) et, 
d' autre part, a au moins une interface numerique (14) avec 

25 au moins un capteur de position (12) embarque sur ledit 
bras (A) , ladite interface etant integree audit bras ou 
situee dans son voisinage immediat . 

2. Robot selon la revendication 1, caracterise en ce 
que ledit bus fonctionnel unique (B) se decompose en au 

30 moins deux bus structurels (Bi, B 2 ) qui relient, pour le 
premier, ladite unite de contrSle (30) audit module (22) 
et, pour le second (B 2 ) ou les suivants, ladite unite de 
controle (30) & ladite interface (14) . 
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3. Robot selon la revendication 2, caracterise en ce 
que ledit premier bus structurel est un bus metallique (B x ) , 
notamment en cuivre. 

4. Robot selon l'une des revendications 2 ou 3, 
5 caracterise en ce que ledit second bus structurel ou 1'un 

desdits autres bus est un bus (B 2 ) en fibres optiques. 

5. Robot* 'selon l'une des revendications precedentes, 
caracterise en ce que ladite unite de controle (30) est 
relive a ladite unite de calcul et de traitement (26) par 

10 un bus de type PCI (28) . 

6. Robot selon l'une des revendications 1 a 4, 
caracterise en ce que ladite unite de controle (30) est 
integree a ladite unite de calcul et de traitement (26). 

7. Robot selon l'une des revendications precedentes, 

15 caracterise en ce qu'il comprend une carte d' identification 

i 

et de calibration (16) embarqu<§e sur ledit bras (A) ou 
situee dans son voisinage immediat, ladite carte §tant 
integree audit bus fonctionnel (B) . 

8. Robot selon l'une des revendications precedentes, 
2 0 caracterise en ce que le ou chaque bus structurel (Bi, B 2 ) 

est apte a §tre etendu par des moyens de connexion 
complementaires (B'i, B' 2 ) pour interagir avec au moins un 
organe externe (12' , 12 7 9 , 14 ' , 14", 22 7 ) traitant de 
1' information. 

25 9, Robot selon l'une des revendications precedentes, 

caracterise en ce que lesdits moyens de liaison comprennent 
egalement un conducteur de puissance (52) reliant ledit ou 
lesdits modules (22) audit bras (A) , independamment dudit 
bus fonctionnel (B) . 

30 10. Robot selon l'une des revendications precedentes, 

caracterise en ce que ledit premier bus structurel (B x ) est 
raccordS directement ou indirectement a des modules de 
puissance (22) dedies chacun a un moteur dudit robot (R) . 
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11. Robot selon 1'une des revendications precedentes, 
caracterise en ce que ladite interface numerique est une 
carte d' interface (14) apte & calculer la Vitesse et/ou 
1' acceleration du mouvement mesure par le ou chaque capteur 

5 associ^ (12) & serialiser son signal de sortie et, 
event uellement, a num^riser les signaux de sortie dudit ou 
desdits capteur's lorsqu'ils sont analogiques. 

12. Robot selon l'une des revendications 1 a 10, 
caracterise en ce que ladite interface est int^gree au 

10 capteur associe et est apte & calculer la vitesse et 
1' acceleration du mouvement mesure par ledit capteur, a 
serialiser son signal de sortie et, eventuellement , a 
numeriser le signal de sortie dudit capteur lorsqu' il est 
analogique . 

15 
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